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Abstract In this article, we address the control problem of unicycle path following, using a rigidly attached target point. 
The initial path following problem has been transformed into a reference trajectory following problem, using saturated con- 
trol laws and a geometric characterization hypothesis, which links the curvature of the path to be followed with the target 
point. The proposed controller allows global stabilization without restrictions on initial conditions. The effectiveness of this 
controller is illustrated through simulations. 



1 Introduction 

The case of vehicle path following using a "target point" (situated at a distance from the vehicle) is well known in the domain 
of automatic vehicle guidance. This technique is often used in robotic vehicles with artificial camera vision, where the camera 
is fixed on the vehicle and the target point (physical or virtual) is situated somewhere in its field of view. This problem has been 
the subject of many research works in the recent years [1.2.3 4,5,6,7]. The dominant trend in the contemporary literature 
is to control either the vehicle's forward velocity (thereby, not controlling the vehicle's orientation), or the instantaneous 
rotational velocity only. Hence, essentially only one actuator is used. 

In (2), a local path following strategy has been proposed, which takes uncertainties into account as well. Their solution 
is based on a control law that comprises of two terms; an open loop control that allows inversion of the nominal model, 
and a closed loop control that stabilizes the resulting system. It should be noted that the error dynamics obtained in |Z) are 
expressed in the Frenet frame associated to the followed path (a technique that has also been discussed in [5 ]). While the use 
of Frenet frames is convenient, its application is local, i.e. the convenience is significant only when the vehicle is close to 
the path (with respect to a universal constant), positioned and oriented. When such ideal situations are not present and the 
vehicle is actually located far from the path, another controller (e.g. an open loop control) takes over to bring the vehicle in 
the path's proximity before the primary controller starts operation. 

In (8][9), a polar state transformation has been used to ensure tracking of smooth plane trajectory for a trailer-truck 
vehicle. This coordinate transformation is not global, therefore the proposed controllers only ensure local stabilization of the 
system. In [10], controllers have been proposed to follow a reference trajectory using a virtual vehicle approach, where the 
motion of the reference point on the desired trajectory is governed by a differential equation containing the error feedback. 
The proposed controllers do not ensure convergence to the reference trajectory itself. In fact the convergence is limited to a 
bounded distance from the trajectory. This is due to the fact that this controller stabilizes the angle variable exponentially. 

In this paper, we present a target point based path following technique for a robot unicycle. The target point has been 
considered fixed with respect to a point on the vehicle. More precisely, the target point is at a fixed distance d > from the 
center of gravity on the axis of the vehicle. Our control objective is to drive the vehicle, such that the target point follows 
the desired path (see Fig. 1 below). We have assumed that the vehicle's velocity is measured only, and not controlled. This 
assumption conforms with practical applications, where other intelligent systems control the velocity, (for example, ABS, 
ESP[h]). 
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The primary objective of this work is to conceive global control laws, which are applicable regardless of the initial 
position and orientation of the vehicle w.r.t. the path to be followed. Hence the problem can be defined as orientation control 
with a forced forward velocity. Our solution is based upon parameterization of the reference path as "the trajectory of a 
unicycle", the forward velocity of which can be considered as a supplementary control variable. A similar approach can be 
found in [ 1 1 and [2|, where orientation control of a vehicle is under consideration. The authors have achieved this through a 
dynamic inversion process, implemented using adaptive parametrization of the followed path. In our work, we have chosen 
the opposite direction, converting the problem of path following into a special case of trajectory following. Furthermore, 
we have also considered the trajectory of the target point as the trajectory of a unicycle. This allows us to express the error 
dynamics as the difference between the unicycle dynamics defined by the reference path, and the unicycle dynamics defined 
by the target point. We have thus obtained a controlled system with three dimensional state and two control inputs (the 
forward velocity of the reference path and the angular velocity of the vehicle) . 

Our control law is based upon state feedback with static error control algorithms, along with saturated input technique 
I12U 13, 14 15 16, 17, 18 19 1. As would be shown further on, the application of bounded inputs is justified by two constraints, 
(a) to maintain the forward velocity on the reference path uniformly bounded, (b) to focus on controlling the orientation 
of the unicycle defined by the target point, rather than controlling the orientation of the vehicle. It is worth mentioning that 
in order to satisfy constraint (b), we have supposed the geodesic curvature of the followed path to be strictly bounded in 
magnitude by the inverse of the distance d. Application of such type of bounded commands in the same context (trajectory 
following of unicycle robots) can be found in [3| . The stability analysis is based on an argument of the Lyapunov type. 
Our contribution, compared to [3 ] is the determination of a strict and global Lyapunov Function on an appropriate basin of 
attraction. As a byproduct, we can handle model uncertainties, external perturbations as well as (constant) delays as indicated 
in a series of remarks preceding the simulation section. 

Acknowledgements. The authors thank E. Panteley and W. Pasillas-Lepine for their constructive remarks. 



2 Vehicle model and reference trajectory 

Let us consider a path y with geodesic curvature K* whose absolute value is bounded by K„ mx > 0. As described in the 
introduction, we want to parameterize y as a unicycle trajectory with a forward velocity u(t) such that y(t) = (p r (t),q r (t)) 
can be described by the following state equations : 

p r = MCOSl|/ r , 

q r = i(sin\|/ r , (1) 

V|/ r = UK r , 

where K r , is the scalar curvature associated to the parametrization of y by time /. The relationship between the arclength 

s of y and time t for the trajectory (p r ,q r ,\\t r ) is given by s(t) = Sq + / uMdx. The scalar curvature K r (r) is hence equal to 

Jo 

K* r (s(t)). For the sake of simplicity, we have assumed in this paper that u is a strictly positive function (i.e., strictly positive 

forward velocity), and moreover, that the controls u verify / u(t)dt = +°°. Furthermore, for all t > 0, we have 

Jo 

|Kr(f)l<1W (2) 

The state equations for the vehicle can be defined as: 

x = V x cos\|/, 

y = V x sin\|/, (3) 
y = V x v, 

These equations represent the vehicle's motion with a velocity V x , along the curve defined by its geodesic curvature v. This 
variable will be considered as the second control in the problem. Notice that V x is not necessarily constant, but simply a 
continuous function of time, which verifies the following hypothesis: there exist two positive constants < V m i„ < V max , such 
that for all t > 

V mi „ < V x (t) < V max . (4) 

Recall that the strict positivity of the lower bound is a necessary assumption to obtain the results of the paper (see, [6 ] for an 
explanation of this classical phenomenon). Indeed, Eq.|4]implies that linearized systems associated to the reference trajectory 
are controllable and thus the nonlinear system is locally controllable. 



For the target point, the equations for the coordinates p and q are defined as: 



p =x + c?cosi|/, 
q =y + dsvn\y. 

We will also suppose throughout the paper that 
(HI) dK max < 1. 

This can be considered as a technical condition, or a design constraint for positioning the target point. However, as 
explained later, condition (HI) turns out to be (almost) necessary to control the system. 
The dynamics of the target point can be obtained by deriving the precedent equations 

p = V x cos\|/ — d V x sin\|/ v, 

q = V x sin\\r + dV x cosi|/ v, (6) 
\jl = V x v. 




Fig. 1 The reference trajectory, the vehicle and its target point. 



The curve defined by the target point is traveled at the following speed: 

v d := Vp 2 +q 2 = Wi + M) 2 - 

Our objective now is to define the dynamics of the target point as those of a unicycle. Therefore, let us consider 6 as the 
angle between the abscissa axis and the velocity vector (p, q) T . It can easily be seen that 6 = V|/+ arctan(dv), and therefore, 



p = v d cos(Q), q = v d sin(Q), 



The scalar curvature CO is defined by CO := — . 

Vd 

Solving these equations, we obtain: 



V x v d v 

& =— + Vd (i+(vjn (7) 

Hence the dynamics of the target point (p, q) becomes 

p = v d cos 6, 

q = v d sine, (8) 
9 = v d co. 

From here on, we will replace v with co as the new control. Considering equation (|7}, we obtain the following form: 

l + (vd) 2 



V : 



-V x [Vl + H) 2 co-v], (9) 



i.e. an ordinary differential equation for the unknown function v. Since the right side of l(9} is not globally Lipschitz 
with respect to v, the solution may only be defined for finite time duration. We will show later on, that a choice of CO under 
Hypothesis (HI) solves this problem (see Lemma[T]below). 

The error between the target point and the reference curve can be defined as: 

e p = P-Pr, 

e g = q-q r , (10) 

and the error dynamics are given by: 



Vd COS 6 — MCOSV)/,-, 

e'q = \'d sin8 — Msinv|/ r , (11) 

\ = V,j CO — K r U. 

The objective, hence, is to determine the control laws, u{t,e p ,e q ,^) and (o(t,e p ,e q ,Z,) such that the closed loop system 
( II lb is globally asymptotically stable (GAS for short) with respect to the origin. 
Let us first of all perform a variable change on the control, as follows: 

u = v d (l+ Ui ), 
CO = K r (l + U\) + U 2 . 

The system that we have to stabilize, becomes: 

e'p = Vrf(cos8 — cosi|/ r — u\ cosi|/,), 

e'q = v rf (sin8 - sini|/,. — u\ sin\|/ r ), (13) 

i = v d u 2 . 

The following lemma provides bounding conditions on u\ and if 2 that would guarantee that the differential equation given 
in (|9} is defined for all times t > 0. 

Lemma 1 Suppose that for all t > 0, there exists 

|mi(?)I + | M2W |<Pm:=-^^. (14) 



d - . j 

Then, the differential equation given by Eq.$9ty is defined for all times t > 0. 
Proof of Lemma[T]Let us multiply lO by v. We obtain: 

. 1 + H) 2 



d 

If vco < 0, then vv < 0. If vco > 0, the precedent equation can be written as 



k[V1 + M) 2 vco-v 2 ]. (15) 



1 + H) 2 , 

VV = \ V r V 



co 2 + v 2 ((J co) 2 -l) 



v/i + (k/) 2 M + |j 



(16) 



In order to guarantee that the right side of (116) is globally Lipschitz with respect to v 2 , it is sufficient to choose u\,u 2 such 
that for all t > 0, 

(d co(f)) 2 -l <0. 

Using d 12b . we can rewrite the equation 

(d C0(f)) 2 - 1 < d 2 (K maJ (l + \ Ul (t)\) + \u 2 (t)\) 2 - 1. 

For the value of this quantity to be less than zero, it is sufficient that d(K max ( \ + \ui(t)\) + \ii2(t)\) < 1, and hence for all t > 0, 

^# + M0I<pV 



In order to verify ( 114K the controls ii\ et u 2 can be expressed in the following form: 



u\ = Ci<j(- 
u 2 = (3o(-) 



(17) 



with (for instance) 



(CondO) 0<d 0<(3<^, (18) 



and a being equal to the standard saturation function 

alx) = 



max(l, \x\) 



Since v is bounded, vj also remains uniformly bounded throughout t > 0. We can hence change the time by considering 
dt' = v c i dt. To keep the notations simple, we would continue to use / for time. This has no effect on the control laws since 
our design is based on static feedback (w.r.t. the error). 

The error dynamics hence becomes: 

e' p = cos6 — cos\|/ r — u\ cos\|/ r , 

e q = sin0 — sini|/ ; - — u\ sin\|/,-, (19) 
| = u 2 . 

Let us perform the following change of variable corresponding to a time-varying rotation in the frame of the reference 
trajectory: 



yi = -e p sini|/ r + e 9 cos\)/, 
The final system can be expressed as 



yi = e p cos\|/ r + e 9 sini|/ r , 



y \ = u\ +(cos^- 1) + (1 +Mi)K r y 2 , 

y 2 = sin^-(l+«i)K,.yi, (21) 
i = u 2 . 

This system of equations greatly resembles the error dynamics obtained for the classic tracking problem of a vehicle 
using a unicycle, with the forward velocity and the instantaneous rotation velocity of the vehicle body as control variables 
(cf. et 0). 

We choose the controls u\ and u 2 as follows: 

ui = CiO(Myi), 

« 2 = pa(^K + pa(C 2 y 2 )]), (22) 

with M, Co , C\ , C 2 , P , p as positive constants to be fixed later. 
Hence the error dynamics are: 

y\ = -C l o{My l )+X{t)y 2 + {cost,- I), 

y 2 = sin^-A,(?).Vi, (23) 
4 = -Pa(^K + po((^)]), 



where X(t) := (1 + U\ )K r . A. is bounded by 



|X(0|<(3 + Ci)tq«. (24) 

Theorem 1: With the control u\ and m 2 defined in d22b . for all Ci and (3 verifying d 1 3b , the system d23l > is GAS with 
respect to 0. 

Proof of Theorem 1 

We first have the following result, which is a trivial consequence of the dynamics of !;(•). 



Lemma 2 For every trajectory of d23l l, there exists to>0 such that, for every t > to : |^(f ) | < 2p. 

This follows from the fact that if > ^-p, then [t, + pa (C 2 y 2 )] has the same sign of i;, and \t, + pa (C2V2) | > ^- Finally, we 

g «K<>(f)<o. 



We next impose the following condition. 



This implies that for t > to, 



Hence, for t > to, the system d23b becomes: 



(Condi) : 3pC < p\ 



jm+Mc&m <i. 



y\ = -Cia(Myi) +X{t)y 2 + (cosl-l) 
y 2 = sin^-A,(?)yi, 
i = -C g + pa(C 2 y 2 )}. 



(25) 



Let £ be a set of points (yi,y 2 ,£,) such that |^| < 2p. According to Lemma|2] £ is an open invariant set for the system 
125) . To prove Theorem 1, it is sufficient to form a strict Lyapunov function for (J25J on E. We propose the following candidate 
function: 



V(yi,y 2 ,Z,) 



Cq 2Cq 



(26) 



0-/ 

7o 



' sins 



with iV a positive constant to be determined, and F( 

Notice that F is an odd function, and if N > — then V is positive definite. We next prove that V is a strict Lyapunov 

Co 

function for l !25l > on E with an appropriate choice of the constants. 

Let us suppose from this point on that p ^ - . Therefore, for $C 2p, one has 



1-4: 



18 ^ \ ^ 



1} 

<cos^l. 



From here, it can be deduced that: 



2 P < sin ^ <r i 



1 — 2p 2 sC cos^ < 1. 



The derivative of V along the trajectories of the system is equal to: 



V 



CiyiO(Myi 



1 



1 / F^sini; 



F($)sin$ 



sin I; 



^ 2 + piV^CT(C 2 y 2 ) + — lpy 2 c(C 2 y 2 ) 



(27) 



(28) 



(29) 



From equations ( 124) and ( 128) . it can be seen that the first term in brackets of equation d29b is greater or equal to: 

AM) - C,»io(M.vi)- (3 + ^ ) ''-" l&il 



(30) 



Similarly, the second term in brackets of equation ( 129) can be bounded by: 

B(y z &) := l ( N -l-)^-p N ^a(C 2 y 2 )\ 

/ 2p 2 \ ( ' 

+ 1 1 --yUyiviCiyi)- 

Hence, using equations (29) , (30b and ( 131b . V can be expressed as: 

V^-A( yi ^)-B(y 2 ^). (32) 
We shall now present two lemmas, and establish the conditions on constants, under which these lemmas would hold true. 
Lemma 3 There exist constants C\ , p, (3,M, N, Co for which the function A is positive definite oniix] — 2p, 2p [. 

Lemma 4 There exist constants C\ , p, (3,M, N, Co for which the function B is positive definite oniix] — 2p, 2p [. 

Proof of Lemma\3} Let us consider 2 cases: 
Case 1: \yi \ > — . 
As |4| 2p, we obtain: 



•4. v,|(C 1 -^i(3+C 1 )-2p 2 ). (33, 



Hence it is sufficient to verify that: 



Ci-^2i(3 + C 1 )-2p 2 >0^C 1 ( ! _ ^P]W\ > ^W p + 2p 2 (34) 
Co V Co J Co 

From here, we obtain a supplementary condition: 

9k- 

—— p < 1. (35) 

(-0 

This condition, along with Condi presented before, is equivalent to: 

(Condi) :9p<^<±. 

Co zp 



Therefore, Ci has to be chosen, such that: 



r ^p + 2p i 

(Cond3) : d > Co _ 2pw . (36) 



Co 

Case 2: | yi | < -. 

As the saturation is no longer activated and \t,\ ^ 2p, we obtain: 

A > Cl My] - ( (3 + < g o )lW +2p) |^| + \(N-^j 4 2 - 07) 
A is greater than quadratic form. To prove that it is positive definite, it is sufficient that 

N -k) >0 



„ „ K majc (3+Ci) 

C\M --p 

2C 



l 



W(3 + Ci) 
2C P 



>0. 



Equation (38) gives us 

2C 



(38) 



Cl M^LA > f W3 + C,) +p , (39l 



Therefore, M should be chosen such that: 

2 / K,„„ J (3+C,) +p \ 2 

{CondA) : M > ^ J- . (40) 

■ 

Proof of Lemma^ B can be expressed in the following manner: 
where 

D(z^):=(l-^)z 2 -C 2 N\^z\ + ^(N-^)^. .42, 



B = ( 1 - 2 4 )(y2 - a (C 2 y 2 ) + ±D (a (C 2 y 2 ) , §) , (41) 



3 J ^ p V Q>J 

It can be seen from equations d41b and d42b . that if D is positive definite, then B is positive definite as well, i.e 

2p 2 -C 2 N 



1 



3 / 2 
2 p V Co 



> 0. (43) 



From here, we obtain a new condition on p: 



2£\ 

(Cond5) : ± ^ > — r-. (44) 



1-^1 C 2 N> 



Therefore, to prove the theorem 1, it has to be shown that there exist constants Co, C\, C 2 , M, N, p, such that conditions 

(Condi) to {condS) are met. In practice, Co and C 2 are given fixed positive values, and then N is fixed such that N > — . 

Co 

Then, p is chosen, small enough to satisfy conditions (condl) and (cond5). Finally, C\ and M are chosen so that they satisfy 
respectively conditions (cond3) and (condA). a 
The results presented above can be improved in the following directions 

Remark 1 Having a strict hyapunov function allows us to extend the precedent results to cases in which external perturba- 
tions exist. More precisely, it can be shown that i25[ is ISS (input-to-state) with respect to bounded external perturbations 
and an upper bound for allowed perturbations can be determined explicitly (as a function of the constants of the problem). In 
particular, it is interesting to suppose that the reference trajectory curvature K r , along with the vehicle velocity V x are suscep- 
tible to measurement noise. Hence the system can be stabilized in the proximity of the reference curve, depending explicitly 
on the magnitude of noise. In the following section, we will present simulation results, both with and without perturbations 
on K r . 



Remark 2 It is possible not to bound the control u 2 as defined in (1221 ) but to simply use 

u 2 = -C g + pa(C 2 y 2 )}. 
The proof of the non-explosion o/© is slightly modified but straigthforward. 



3 Simulations 

In order to illustrate the performance of the presented controller, let us consider a unicycle type vehicle, with the following 
parameters: 

d = 2 in, Vj = 15 m.S~ . 

The maximum curvature in the simulation is bounded by K max = 0.02 m . In order to highlight our claim that the 
performance of the controller is global and independent of initial condition, the value of dK max has been kept much smaller 
than 1 (in particular, ^(0) close to 7t). 



The initial conditions imposed upon the error are 

e p (0) = e q (0) = 10 m, ^(0) = 9ji/10. 

The control law ui, U2 are defined by 

Ml = Cio(Afyi),i^ = ~Mj K + P<J(Ca^)]), 

where, the parameters have been determined according to Lemma 2.3 and Lemma 2.5, specifically: 

C = 0.4 , C\ = 0.7 , C 2 = 1 , M = 1562 , (3 = 0.96 , p = 0.2 . 

The path to be followed y is defined by the geodesic curvature K r (see Fig. [2}. It can be seen that the vehicle follows the 
target reference path as shown in Figure [3] The target point trajectory converges on the path in approximately 7 sec. (see 
Fig.[4]l, and the vehicle successfully tracks the reference trajectory. The graphs of the control function are given in Fig.[5]and 
Fig.© 

4 Conclusion 

In this article, we have addressed the problem of path following using a target point rigidly attached to a unicycle type vehicle. 
The control has been implemented using only the orientation of the vehicle. The main idea is to consider the parametrization 
of the followed path as an additional input for the system defined by the error dynamics. Control laws using saturation 
have been determined in order to achieve global stabilization without restrictions on initial conditions, under a (necessary) 
geometric characterization hypothesis, which relates the followed path with the target point position. This approach can also 
be extended to the cases where there are external perturbations or uncertainties in the model. This work can be extended 
towards addressing similar issues in more elaborate car models. 
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Fig. 3 Reference trajectory, of the vehicle and its target point. 




time 



Fig. 4 Errors e p , e q et £, 



































A 






















\ 






















I 








f 































































5 10 15 20 25 30 35 40 45 50 

time 



Fig. 5 Control u 
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